
from simulation_process import VrepProcess



mainProcess = VrepProcess()

mainProcess.simConnect()
mainProcess.simSetup(0.01, 100)

baseName = ['base_link']
jointName = ['shoulder','elbow']
mainProcess.simGetHandle(baseName, jointName)

currentTime, baseConfig, jointConfig = mainProcess.simGetInfo()

print(currentTime)
print(baseConfig)
print(jointConfig)

control_force = [1,2]
print(control_force)
mainProcess.simSetCmd(control_force)
